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Abstract 

Proposed in this paper is a kinetostatic performance index for the optimum dimen- 
sioning of planar manipulators of the serial type. The index is based on the concept 
of distance of the underlying Jacobian matrix to a given isotropic matrix that is 
used as a reference model for purposes of performance evaluation. Applications of 
the index fall in the realm of design, but control applications are outlined. The 
paper focuses on planar manipulators, the basic concepts being currently extended 
to their three-dimensional counterparts. 



1 Introduction 

Various performance indices have been devised to asses the kinetostatic per- 
formance of serial manipulators. Among these, the concepts of service angle 
[1], dexterous workspace [2] and manipulability [3] are worth mentioning. All 
these different concepts allow the definition of the kinetostatic performance 
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of a manipulator from correspondingly different viewpoints. However, witfi 
the exception of Yoshikawa's manipulability index [3], none of these considers 
the invertibility of the Jacobian matrix. A dimensionless quality index was 
recently introduced by Lee [4] based on the ratio of the Jacobian determi- 
nant to its maximum absolute value, as applicable to parallel manipulators. 
This index does not take into account the location of the operation point in 
the end-effector, for the Jacobian determinant is independent of this location. 
The proof of the foregoing fact is available in [5] , as pertaining to serial ma- 
nipulators, its extension to their parallel counterparts being straightforward. 
The condition number of a given matrix is well known to provide a measure 
of invertibility of the matrix [6]. It is thus natural that this concept found 
its way in this context. Indeed, the condition number of the Jacobian matrix 
was proposed by Salisbury [7] as a figure of merit to minimize when design- 
ing manipulators for maximum accuracy. In fact, the condition number gives, 
for a square matrix, a measure of the relative roundoff-error amplification of 
the computed results [6] with respect to the data roundoff error. As is well 
known, however, the dimensional inhomogeneity of the entries of the Jacobian 
matrix prevents the straightforward application of the condition number as 
a measure of Jacobian invertibility. The characteristic length was introduced 
in [8] to cope with the above-mentioned inhomogeneity. Apparently, never- 
theless, this concept has found strong opposition within some circles, mainly 
because of the lack of a direct geometric interpretation of the concept. It is 
the aim of this paper to shed more light in this debate, while proposing a 
novel performance index that lends itself to a straightforward manipulation 
and leads to sound geometric relations. Briefly stated, the performance index 
proposed here is based on the concept of distance in the space of m x n ma- 
trices, which is based, in turn, on the concept of inner product of this space. 
The performance index underlying this paper thus measures the distance of 
a given Jacobian matrix from an isotropic matrix of the same gestalt. With 
the purpose of rendering the Jacobian matrix dimensionally homogeneous, we 
resort to the concept of posture-dependent conditioning length. Thus, given 
an arbitrary serial manipulator in an arbitrary posture, it is possible to define 
a unique length that renders this matrix dimensionally homogeneous and of 
minimum distance to isotropy. The characteristic length of the manipulator is 
then defined as the conditioning length corresponding to the posture that ren- 
ders the above-mentioned distance a minimum over all possible manipulator 
postures. This paper is devoted to planar manipulators, the concepts being 
currently extended to spatial ones. 
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2 Algebraic Background 



Given two arbitrary m x n matrices A and B of real entries, their inner 
product, represented by (A, B), is defined as 

(A, B) = tr(AWB^) (1) 



where W is a positive-definite n x n weighting matrix that is introduced to 
allow for suitable normalization. The entries of W need not be dimensionally 
homogeneous, and, in fact, they should not if A and B are not. However, 
the product AWB^ must be dimensionally homogeneous; else, its trace is 
meaningless. The norm of the space of m x n matrices induced by the above 
inner product is thus the Frobenius norm, namely, 

||A||2 = tr(AWA^) (2a) 



Moreover, we shall be handling only nondimensional matrix entries, and hence, 
we choose W non-dimensional as well, and so as to yield a value of unity for 
the norm of the nx n identity matrix 1 . Hence, 

W = -1 (2b) 
n 



The foregoing inner product is thus expressed as 

(A, B) = -tr(AB^) (2c) 
n 



Henceforth we shall use only the Frobenius norm; for brevity, this will be 
simply referred to as the norm of a given matrix. 

When comparing two dimensionless m x n matrices A and B, we can define 
their distance ci(A, B) as the Frobenius norm of their difference, namely, 

d(A, B) = ||A-B|| (3a) 



I.e., 



d(A, B) = W-tr[(A-B)(A-B)^] 



n 



(3b) 
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An m X n isotropic matrix, with m < n, is one with a singular value cr > of 
multiplicity m, and hence, if the m x n matrix C is isotropic, then 



CC^ = a'l 



(4) 



where 1 is the m x m identity matrix. Note that the generalized inverse of C 
can be computed without roundoff-error, for it is proportional to C-^, namely. 



fee 



T\-lr^T 



(5) 



Furthermore, the condition number k{A) of a square matrix A is defined [6] 



as 



k{A) = ||A||||A-^| 



(6) 



where any norm can be used. For purposes of the paper, we shall use the 
Frobenius norm for matrices and the Euclidian norm for vectors. Henceforth 
we assume, moreover, a planar n-revolute manipulator, as depicted in Fig. 1, 
with Jacobian matrix J given by Angeles [5] 



1 1 ••• 1 
Eri Er2 • • • Er^ 



(7) 



where is the vector directed from the center of the ith revolute to the 
operation point P of the end-effector, while matrix E is defined as 



E = 



-1 

1 



(8) 



i.e., E represents a counterclockwise rotation of 90°. It will prove convenient 
to partition J in the form 



A 
B 



with A and B defined as 



1 1 ••• 1 



and B 



Eri Er2 • • • Er„ 
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Therefore, while the entries of A are dimensionless, those of B have units of 
length. Thus, the sole singular value of A, i.e. the nonnegative square root of 
the scalar of AA^, is y^, and hence, dimensionless, and pertains to the map- 
ping from joint-rates into end-effector angular velocity. The singular values of 
B, which are the nonnegative square roots of the eigenvalues of BB^, have 
units of length, and account for the mapping from joint-rates into operation- 
point velocity. It is thus apparent that the singular values of J have different 
dimensions and hence, it is impossible to compute k{J) as in eq.(6), for the 
norm of J, as defined in eqs.(2a & b), is meaningless. The normalization of 
the Jacobian for purposes of rendering it dimensionless has been judged to be 
dependent on the normalizing length [9] . As a means to avoid the arbitrariness 
of the choice of that normalizing length, the characteristic length L was intro- 
duced in [10]. Since the calculation of L is based on the minimization of an 
objective function that is elusive to a straightforward geometric interpretation, 
namely, the condition number of the normalized Jacobian, the characteristic 
length has been found cumbersome to use in manipulator design. We intro- 
duce below the concept of conditioning length to render the Jacobian matrix 
dimensionless, which will allow us to define the characteristic length using a 
geometric approach. In the sequel, we will need the partial derivative of the 
trace of a square matrix N with respect to a scalar argument x of N. The said 
derivative is readily obtained as 



Moreover, in some instances, we will need the partial derivative of a scalar 
function / of the matrix argument N with respect to the scalar x, which is, in 
turn, an argument of N. In this case, the desired partial derivative is obtained 
by application of the chain rule: 



In particular, when /(N) is the kth moment of N with respect to x, defined 
as 




(9a) 




(9b) 



iVfc = tr(N^) 



(9c) 



the partial derivative of A^^ with respect to x is given by 




(9d) 
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Furthermore, we recall that the trace of any square matrix N equals that of 
its transpose, i.e., 

tr(N^) = tr(N) (10a) 



and, finally, the trace of a product of various matrices compatible under mul- 
tiplication docs not change under a cyclic permutation of the factors, i.e., if 
A, B, and C are three matrices whose product ABC is possible and square, 
then tr(ABC) =tr(BCA)= tr(CAB) 



3 Isotropic Sets of Points 



Consider the set 5 = { }i of n points in the plane, of position vectors 
{ Pfe }i ) and centroid C, of position vector c, i.e., 

1 " 

c^-Ep^ (11) 



The summation appearing in the right-hand side of the above expression is 
known as the first moment of S with respect to the origin O from which the 
position vectors stem. The second moment of S with respect to C is defined 
as a tensor M, namely, 

n 

M = E(Pfc-c)(Pfe-c)^ (12) 

1 



It is now apparent that the root-mean square value of the distances { dk }i of 
S-i d-rxas-i to the centroid is directly related to the trace of M, namely. 



dxxas — 



^i:(P*-cr(pt-c) = ,/itr(M) 



n 



n 



(13) 



Further, the moment of inertia I of 5 with respect to the centroid is defined 
as that of a set of unit masses located at the points of i.e., 

n 

I = ^[ llpfc - cll^l - (pfe - c)(pfe - c)^] (14a) 
1 
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in which 1 is the 2x2 identity matrix. Hence, in hght of definitions (12) and 
(13), 

I = tr(M)l-M (14b) 



We shall refer to I as the geometric moment of inertia of S about its centroid. 
It is now apparent that I is composed of two parts, an isotropic matrix of 
norm tr(M) and the second moment of S with the sign reversed. Moreover, 
the moment of inertia I can be expressed in a form that is more explicitly 
dependent upon the set { — c if wc recall the concept of cross-product 
matrix [5]. Briefly stated, for any three-dimensional vector v, we define the 
cross-product matrix of (p^ — c), or of any other three-dimensional vector 
for that matter, as 

P» . (15a) 
av 



Further, we recall the identity [5] 

Fl = -Hp, - c\\H + (pfc - c)(pfc - c)^ (15b) 

It is now apparent that the moment of inertia of S takes the simple form 

n 

l=-EPl (16) 



1 



We thus have 

Definition 1 (Isotropic Set) The set S is said to be isotropic if its second- 
moment tensor with respect to its centroid is isotropic. 

As a consequence, we have 

Lemma 1 The geometric moment of inertia of an isotropic set of points about 
its centroid is isotropic. 



3.1 Geometric Properties of Isotropic Sets of Points 



We describe below some properties of isotropic sets of points that will help us 
better visualize the results that follow. 
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3.1.1 Union of Two Isotropic Sets of Points 



Consider two isotropic sets of points in the plane, Si = {Pk }" and S2 ~ 
{ Pk }nXT- If the centroid C of the position vector c of Si coincides with that 
of S2, i.e. if, 



-Epfe^-Epfe (17) 



rii m 



then, the set S = SiU S2 is isotropic. 

For example, let Si be a set of three isotropic points and «S2 a set of four 
isotropic points, as displayed in Fig. 2, i.e.. 



Si = { 



So = < 



-V6/2 
-\/2/2 



-V2 



-V2/2 





V2 





-V2 









V2 

















(18a) 



where the centroid C is the origin. The second moment of S with respect to 
C is isotropic, namely. 



3+4 



M = E(Pit-c)(Pik-c) 



7 
7 



(7)1 



(18b) 



where 1 denotes the 2x2 identity matrix. Furthermore, the geometric moment 
of inertia of S is 



1 = (14)1 - (7)1 = (7)1 

Lemma 2 The union of two isotropic sets of points sharing the same centroid 
is also isotropic. 



3.1.2 Rotation of an Isotropic Set of Points 

Let R denote a rotation matrix in the plane through an angle a and S = 
{ Pk }i a set of isotropic points. A new set of points S' = { }" is defined 
upon rotating S through an angle a about C as a rigid body. The second 
moment of S' with respect to C is shown below to be isotropic as well. Indeed, 
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letting this moment be M', we have 



M'^E(p'.-c')(p'.-c'r 
1 

where, by definition, 

Pfc - c' = R(Pfe - c) 
Thus, 

n n 

M' = ER(pfe - c)(pfe - c)'^R^ = R[E(Pfc - c)(Pfc - c)^]R^ 
1 1 

But the summation in brackets is the second moment M of the set S, which 
is, by assumption, isotropic, and hence, takes the form 

n 

M=E(Pfc-c)(Pfc-cr=<^'i 

1 

for a real number a > and 1 denoting the 2x2 identity matrix. Hence, 

thereby proving that the rotated set is isotropic as well. We thus have 

Lemma 3 The rotation of an isotropic set of points as a rigid body with 
respect to its centroid is also isotropic. 

The counterclockwise rotation of an isotropic set of three points, S, through 
an angle of 60° and the union of the original set and its rotated counterpart 
are depicted in Fig. 3. Note that the union of the two sets is isotropic as well. 



3.1.3 Trivial Isotropic Set of Points 

An isotropic set of points can be defined by the union or rotation, or a com- 
bination of both, of isotropic sets. The simplest set of isotropic points is the 
set of vertices of a regular polygon. We thus have 

Definition 2 (Trivial isotropic set) A set of n points S is called trivial if 
it is the set of vertices of a regular polygon with n vertices. 
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Trivial isotropic sets, S — {Pk}i are depicted in Fig. 4, for n = 3, • • • , 6. 

Also note that 

Lemma 4 A trivial isotropic set S remains isotropic under every reflection 
about an axis passing through the centroid C. 



4 An Outline of Kinematic Chains 

The connection between sets of points and planar manipulators of the serial 
type is the concept of simple kinematic chain. For completeness, we recall here 
some basic definitions pertaining to this concept. 

4-1 Simple Kinematic Chains 

The kinematics of manipulators is based on the concept of kinematic chain. A 
kinematic chain is a set of rigid bodies, also called links, coupled by kinematic 
pairs. In the case of planar chains, two lower kinematic pairs are possible, the 
revolute, allowing pure rotation of the two coupled links, and the prismatic 
pair, allowing a pure relative translation, along one direction, of the same links. 
For the purpose of this paper, we study only revolute pairs, but prismatic pairs 
are also common in manipulators. 

Definition 3 (Simple kinematic chain) A kinematic chain is said to be 
simple if each and every one of its links is coupled to at most two other links. 

A simple kinematic chain can be open or closed; in studying serial manipula- 
tors we are interested in the former. In such a chain, we distinguish exactly 
two links, the terminal ones, coupled to only one other link. These links are 
thus said to be simple, all other links being binary. In the context of manipu- 
lator kinematics, one terminal link is arbitrarily designated as fixed, the other 
terminal link being the end-effector (EE), which is the one executing the task 
at hand. The task is defined, in turn, as a sequence of poses — positions and 
orientations — of the EE, the position being given at a specific point P of the 
EE that we term the operation point. 

4-2 Isotropic Kinematic Chains 

To every set 5 of n points it is possible to associate a number of kinematic 
chains. To do this, we number the points from 1 to n, thereby defining n — 1 
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links, the ith link carrying joints i and i + 1. Links are thus correspondingly 
numbered from 1 to n, the nth link, or EE, carrying joint n on its proximal 
(to the base) end and the operation point P on its distal end. Furthermore, 
we define an additional link, the base, which is numbered as 0. 

It is now apparent that, since we can number a given set S of n points in n\ 
possible ways, we can associate n! kinematic chains to the above set 5 of n 
points. Clearly, these chains are, in general, different, for the lengths of their 
hnks are different as well. Nevertheless, some pairs of identical chains in the 
foregoing set are possible. 

Definition 4 (Isotropic kinematic chain) If the foregoing set S of n points 
is isotropic, and the operation point P is defined as the centroid of S, then 
any kinematic chain stemming from S is isotropic. 



5 The Posture-Dependent Conditioning Length of Plancir n-Revolute 
Manipulators 



Under the assumption that the manipulator finds itself at a posture V that is 
given by its set of joint angles, { 9k }" , we start by dividing the last n rows of 
the Jacobian by a length l-p, as yet to be determined. This length will be found 
so as to minimize the distance of the normalized Jacobian to a corresponding 
isotropic matrix K, subscript V reminding us that, as the manipulator changes 
its posture, so does the length l-p. This length will be termed the conditioning 
length of the manipulator at V. 



5.1 A Dimensionally-Homogeneous Jacobian Matrix 



In order to distinguish the original Jacobian matrix from its dimensionally- 
homogeneous counterpart, we shall denote the latter by J, i.e.. 



J = 



1 1 ••• 1 

{l/h) En (l/lr) Er2 ■ • • (l/h) Er, 



Now the conditioning length will be defined via the minimization of the dis- 
tance of the dimensionally-homogeneous Jacobian matrix J of an n-revolute 
manipulator to an isotropic 3 x n model matrix K whose entries are dimen- 
sionless and has the same gestalt as any 3 x n Jacobian matrix. To this end, 
we define an isotropic set /C = { }" of n points in a dimensionless plane, of 
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position vectors { kj which thus yields the dimensionless matrix 



K 



1 1 ••• 1 
Eki Ek2 • • • Ek„ 



(19) 



Further, we compute the product KK 



T. 



E?Ek, E?Ek,kfE^_ 

Upon expansion of the summations occurring in the above matrix, we have 



EkrE^ = (EEk.r = E(^k,)^ 
11 1 

n n 

EEk,krE^=E(i:k,knE^ 



(20a) 
(20b) 



Now, by virtue of the assumed isotropy of /C, the terms in parentheses in the 
foregoing expressions become 



1 

n 

Ek,kf = ^2l2x2 
1 

where the factor /c^ is as yet to be determined and l2x2 denotes the 2x2 
identity matrix. Hence, the product KK^ takes the form 



n 

k^l2x2 



(21) 



Now, in order to determine /c^, we recall that matrix K is isotropic, and hence 
that the product KK^ has a triple eigenvalue. It is now apparent that the 
triple eigenvalue of the said product must be n, which means that 



(22) 



and hence. 
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f:k,kf =(n)l2x2 

1 



5.2 Example 1: A Three- D OF Planar Manipulator 



Shown in Fig. 5a is an isotropic set K, of three points, of position vectors 
{ kj }", in a nondimensional plane. The position vectors are given by 







-V6 









, k3 = 




V2_ 


2 


_ V2_ 




_-V2_ 



(23a) 



Hence, the corresponding model matrix is 



K = 



1 1 1 

\/6/2 



(23b) 



which can readily be proven to be isotropic, with a triple singular value of A; = 
\/3. When the order of the three vectors is changed, the isotropic condition is 
obviously preserved, for such a reordering amounts to nothing but a relabelling 
of the points of fC. Also note that two isotropic matrices K are associated with 
two symmetric postures, as displayed in Fig. 5b 



5.3 Example 2: A Four-DOF Redundant Planar Manipulator 



An isotropic set K. of four points, { Ki }f, is defined in a nondimensional plane, 
with position vectors kj given below: 



ki 



'V2' 


, k2 = 


'-V2' 


, k3 = 


'-V2' 


, k4 = 


" V2' 


V2_ 




_ V2_ 




_-V2_ 




_-V2_ 



(24a) 



which thus lead to 



K 



1111 
-V2 -V2 V2 V2 
V2 -V2-V2V2 



(24b) 
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Wc thus have 4! = 24 isotropic kinematic chains for a four-dof planar manipu- 
lator, but we represent only 6 in Fig. 6 because the choice of the first point is 
immaterial, since this choice amounts to a rotation of the overall manipulator 
as a rigid body. 



5.4 Computation of the Conditioning Length 



We can now formulate a least-square problem aimed at finding the condition- 
ing length l-p that renders the distance from J to K a minimum. The task will 
be eased if we work rather with the reciprocal oi l-p, A = 1/l-p, and hence, 

^ = ^-tr[(J-K)(J-K)^] ^ min (25) 
2 n 



Upon expansion. 



z = --trrjj'^ - JK^ - Kf + KK^) 

2 n 



Since the trace of a matrix equals that of its transpose, i.e., 

tr(JK^) = tr(KJ^) 

the foregoing expression for z reduces to 

z = ^-tr(Jj'^ - 2KJ^ + KK^) (26) 
2 n 



It is noteworthy that the above minimization problem is (a) quadratic in A, 
for J is linear in A and (b) unconstrained, which means that the problem 
accepts a unique solution. This solution can be found, additionally, in closed 
form. Indeed, the optimum value of A is readily obtained upon setting up the 
normality condition of the above problem, namely, 

— = — tr ' - -tr K— - = 27 
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where we have used the hnearity property of the trace and the derivative 
operators. We calculate below the quantities involved: 



T 

JJ = 



n 



A El rjE' 



— T 

,KJ 



n 



AE?rjE 



Tt?T 



EiEk,- AE^EVjE 



Thus, 



djJJ 

dX 







EirTE^ 



EiEr,- 2AE?ErjrjE^ 



K 



dX 



Eir[E^ 



E?Ek,-rjE'^ 



whence the normality condition (27) becomes 



AEiir.ir-Ek; 



1 1 

Now, if we notice that ||rj|| is the distance dj from the operation point P to 
the center of the jth revolute, the first summation of the above equation yields 
^•^rms' with (irms denoting the root-mean-square value of the set of distances 
{ dj }i , and hence, 

^ _ z^i '^i '■J _^ l-p — ™s (^28) 



Thus, the conditioning length is defined so that sfndrms is the geometric 
mean between and the sum of the projections of the set { }" onto the 
corresponding vectors of the set {k^ as illustrated in Fig. 7. 



5.5 A Rotation of the Isotropic Set as a Rigid Body 



Since a rigid-body rotation of a set of isotropic points preserves isotropy, we 
can find the orientation of this set, as parameterized by the angle of rotation a, 
that renders z a minimum, for a given manipulator posture. Let this rotation 
be R(q;), which can be expressed as [11] 

R(a) = (cosa)l + (sina)E (29) 



with E defined in eq.(8). Thus, upon rotating the set /C through an angle 
a about its centroid C or, equivalently, about the operation point P, the 
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isotropic matrix K becomes K, and is given by 



K = 



1 1 ••• 1 

ER(Q;)ki ER(Q;)k2 • • • ER(Q;)k„ 



(30a) 



The objective function z then becomes 



z — 



2n 



tr( J J ) - 2tr( JK' ) + tr(KK' ) 



mm 

a 



(30b) 



Before setting up the normahty conditions for the problem at hand, we note 
that 



KK^ = 



n (E?kO^E^R^(a) 
R(Q;)EE?k, R(Q;)E(E?k,kf)E^R^(a) 



(31) 



which can be shown to reduce to 



KK' 



and hence, 



(Erk,)^E^R^(a) 

R(a)EEiki 



a[tr(KK'^)] 
da 



= 



On the other hand, J is independent of a, and hence, the normahty condition 
of problem (30b) reduces to 



^ = _1 
da n 







(32) 



We calculate below the partial derivative required above: 



dK _ • • • 

^« R'(a)Eki R'(a)Ek2 • • • R'(a)Ek, 

where R'(q;) can be expressed, in light of relation (29), as 
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R'{a) = ER(q;) 

and hence, 



dK 

da 

whence, 
tr I J 



••• 

ER(Q;)Eki ER(Q;)Ek2 • • • ER(Q;)Ek^ 



da 



Atr{^Erj[ER(a)Ekj]^} = rjE'^ER(a)Ekj- 
1 1 

Af:rjR(a)Ek, 



Now, under the plausible assumption that l-p is finite, A 7^ 0, and hence, the 
normality condition (32) reduces to 



^rjR(a)Ek, = 
1 

Further, substitution of expression (29) into the above expression leads to 

n n 

(cos a) J2 rjEkj- - (sin a) J2 ^J^j = (33) 



Therefore, the value of a minimizing the distance of J to K(q;) is, for the given 
posture V, 



a — arctan 



[E^rjEk,] 




= arctan 


. Eirjkj _ 



:i/n)E?rjEk, 
(l/n)EMk, 



(34) 



Thus, the angle a through which the given isotropic set /C is to be rotated in 
order to obtain the conditioning length of the manipulator pose V is given as 
the arctan function of the ratio of a numerator to a denominator D, whose 
geometric interpretations are straightforward: D is simply the mean value 
of the projections of the vectors onto their corresponding kj vectors. Now, 
since Ekj is vector kj rotated 90° counterclockwise, is the mean value of the 
projections of the vectors onto their corresponding Ek^ vectors. We can call 
the latter the transverse projections of the said vectors. Once we have found 
the optimum value ctopt of a for a given manipulator posture, we redefine, for 
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conciseness, 



K 



K(aopt) 



(35) 



With ttopt known, l-p is readily computed from eq.(28). Now, if we regard 
the columns of J and K as 3-dimensional vectors, then a rotation Q of the 
corresponding 3-dimensional space about an axis normal to the plane of the 
sets { }" and { k^}" through an angle q can be represented as 



Q 



1 0^ 
OR{q) 



where R(?) is a 2 x 2 rotation matrix similar to R(q;), as defined in eq.(29). 
Hence, under rotation Q, J and K change as described below: 



QJ 



1 0^ 

OR{q) 

1 



(l/h) En (l/lr) Er2 • • • (l/h) Er„ 



R(g)Eri R(g)Er2 • • • R(g)Er, 



QK 



1 



1 



R(g)Eki R(g)Ek2 • • • R(g)Ek„ 



Now it is apparent that z, as defined in eq.(25), is invariant under a rotation 
R(q') of the sets S and /C. Indeed, under such a rotation. 



1 1 

ZQ = — tr(QJJ^Q^ - QKJ^Q^ - QJK^Q^ + QKK^Q^) 

2 n 

^ ^ tr[Q(JJ^ - KJ^ - JK^ + KK^)Q^] 



2n 

If we recall relation (10), the above expression becomes 



ZQ = --tr[Q^Q(Jj'' - KJ^ - JK^ + KK^ 

2n 



We thus have proven 



(36) 



Lemma 5 The distance of J to K is invariant under a rotation of the sets S 
and fC. 



18 



5.6 The Optimum Posture 



It is now apparent that we can always orient the K, set optimally, so that, for 
any posture V, J lies a minimum distance from the corresponding matrix K. 
Moreover, by virtue of Lemma 5, a rotation of the whole manipulator as a 
rigid body about its first joint, i.e., a motion of the manipulator with all its 
joints but the first one locked, does not affect z. That is, 2; is a function of 
only {9i}2, which can thus be termed the set of conditioning-joint variables, 
the associated joints being the conditioning joints. Now we aim at finding the 
optimum posture Vo that yields a dimensionless Jacobian J lying a minimum 
distance to the reference matrix K. To this end, we adopt a given set /C at a 
given orientation at the outset, which thus leads to a constant matrix K in the 
process of finding Vo, the optimum orientation of /C being readily determined 
from eq.(34) once Vo has been found. Thus, in the derivations that follow, 9i 
can be set arbitrarily equal to zero, or to any other constant value, for that 
matter. We now aim at solving the problem 



An attempt to solving this problem using the approach of the foregoing sec- 
tions proved to be impractical. Indeed, since z depends on the set of condition- 
ing joint variables both via the set { }" and via A, this dependence leads to 
a normality condition that does not lend itself to a closed-form solution. As a 
consequence, the said normality condition does not lead to a direct geometric 
interpretation of the optimum posture. 

We thus follow a different approach here. For each posture, the value of A 
is computed using eq.(28), while a is computed with the eq.(34). With the 
foregoing expressions substituted into the expression of z given in eq.(37), the 
corresponding normality conditions for angles yield a system of algebraic 
equations in the foregoing conditioning variables that are amenable to solu- 
tions using modern methods, like polynomial continuation, Grobner bases, or 
resultant methods [12], that yield all roots of the problem at hand. These roots 
then lead to the globally-optimum posture Vo- 

5.7 The Characteristic Length 

The optimum postures of a given manipulator, i.e., those with a Jacobian 
matrix closest to a corresponding model matrix K are thus found upon solving 
the optimization problem (37). Moreover, the conditioning length associated 
with the posture yielding a global minimum of the foregoing distance is defined 




1 1 



(37) 



mm 
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as the characteristic length of the manipulator at hand. Prior to discussing 
some examples, we would like to find out whether the characteristic length thus 
found bears a minimality geometric property, e.g., whether the characteristic 
length is the minimum conditioning length of the manipulator over its whole 
workspace. To this end, we rewrite the objective function z in the form 

-1 n n 

, = ^(A^'n^s - 2AEkJr, + ^ imin (38) 



Upon substitution of the sum X^i kjfj in terms of the optimum value of A 
found in eq.(28) into eq.(38), we obtain 

-in 1 in 1 /r/ \ ^ 

^ = -1 V ||kJ|2 - ^X'd',^, = 77- E imil' - M ^ (39) 



It is apparent from the above expression that minimizing z is not equivalent to 
minimizing l-p, but rather to maximizing the ratio dj-ms/^-p- Hence, minimizing 
z is equivalent to minimizing the inverse ratio, i.e., l-p/drms- In other words, 
minimizing z is equivalent to minimizing the ratio of the conditioning length 
to the rms value of the distances of the joint centers from the operation point. 



5.8 Examples: A Three-DOF Planar Manipulator 



5.8.1 An Isotropic Manipulator 



In the first example, we have oi = 02 = / and 03 = \/3l/3, with the { }f 
vectors given by 



ri = / 



cos(6'i) + cos(6'i2) + COs(6'i23) 



r2^l 



cos(6'i2) + COs(6'i23) 
sin(6'i2) + sin(6'i23) 



sin(^i) + sin(6'i2 

Vsi 

,r3 = ^ 



+ sin(6'i23) 

cos(6'i23) 
sin(6'i23) 



with the definition = 6i + 6j + . . . + p. Moreover, the model matrix K 
used for this case is that found for the case of an isotropic set of three points. 
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as discussed in Subsection 5.2, and reproduced below for quick reference: 



K 



1 1 1 

-^2/2 -^2/2 sf2 
yfll2 -^fljl 



(40) 



One optimum posture found with the procedure discussed in Subsection 5.6 is 
displayed in Fig. 8, the objective function attaining a minimum of zero at this 

posture, which means that the manipulator can match exactly an isotropic 
model matrix K within its workspace, the manipulator thus being termed 
isotropic. The objective function attains the values displayed in Fig. 9 over its 
whole workspace. 

At the optimum posture, we have the values of the joint variables given below: 



= 0°, Q2 = 120°, ^3 = 150° 

the conditioning length being equal to (\/6/6) /, which is thus the charac- 
teristic length of this manipulator, as found using an alternative approach in 
[5]. Moreover, the normalized Jacobian J becomes 



1 11 

-v^/2 -V2/2 
V6/2 -V6/2 



5.8.2 An Equilateral Manipulator 

In the second example, we assume that all the link lengths are equal to I, and 
hence. 



r3 = / 



cos(6'i) + cos(6'i2) + COs(6'i23) 
sin(^i) + sin(^i2) + sin(^i23) 

cos(6li23) 



, r2 = / 



cos(6'i2) + COs(6'i23) 
sin(6'i2) + sin(6'i23) 



(41) 



sin(6'i23) 

We call this manipulator equilateral. 

For this case, we use the same model matrix K that we used in the previous 
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example, for the manipulator has the same number of joints, and only one K 
was found — up to a reflection — for this number of joints. The minimization of 
the objective function leads to the optimum values 

= 0°, 62 = 81.8°, 63 = 155.2° 



which correspond to a minimum value oi z — 0.178, the associated charac- 
teristic length being l-p = 0.563/. The corresponding posture is displayed in 
Fig. 10, while the objective function, evaluated throughout the workspace of 
the manipulator, is displayed in Fig. 11. 

Finally, the normahzed Jacobian at the posture of Fig. 10 is 



111 
-0.268 -0.268 1.489 
1.061 -0.714 -0.966 



5.9 The Isocontours of the Objective Function 



The minimum of the objective function z corresponds to the posture closest 
to isotropy. At the other end of the spectrum, the maximum of this func- 
tion is attained at those singular postures whereby the rank of the Jacobian 
matrix is two. The curves of constant 2;-values, termed the isocontours of the 
manipulator, can be used to define a performance index to compare manipula- 
tors, as described below. The isocontours were obtained with Surfer, a Surface 
Mapping System, for 62 and ^3 G [0, 27r]. The isocontours of the isotropic ma- 
nipulator, of the first example, are displayed in Fig. 12; those of the equilateral 
manipulator in Fig. 13. 

It is apparent from the two foregoing figures that the isocontours can be closed 
or open. If closed, the curves enclose the optimum point in the space of con- 
ditioning joints; in the second case, the curves are periodic. The shape of the 
closed curves, additionally, provides useful information on the manipulator 
performance: For the isotropic manipulator, when the objective function is 
below 0.25, the curves are close to circular, as shown in Fig. 14; for the equi- 
lateral manipulator, these curves are close to elliptical, as shown in Fig. 15. 
This means that, in the neighborhood of an optimum, the isocontours behave 
in a way similar to the manipulability ellipsoid [3]: An isotropic manipulator 
entails a manipulability ellipsoid with semiaxes of identical lengths. 
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6 Applications to Design and Control 



Manipulators are designed for a family of tasks, more so than for a specific 
task — manipulator design for a specific task defeats the purpose of using a 
manipulator, in the first place! The first step in designing a manipulator, 
moreover, is to dimension its links. It is apparent that from a purely geometric 
viewpoint, the link lengths are not as important as the link-length ratios. Once 
these ratios are optimally determined, the link lengths can be obtained based 
on requirements such as maximum reach for a given family of tasks, e.g., 
whether the manipulator is being used for cleaning a wide-body or a regional 
aircraft. Now, the maximum reach is directly proportional to the drms value of 
the distance of the joint centers to the operation point at the optimum posture, 
and hence, we can obtain the optimum link-length ratios by assuming that 
drms is equal to one unit of length. This means that minimizing the objective 
function 2;, as given by eq.(39), is equivalent to minimizing the normalized 
conditioning length l-p, where the normalization is carried out upon dividing 
this length by (irms- Furthermore, when deciding on the manipulator link- 
length ratios, we may specify a certain useful workspace region as a subset 
of the whole workspace. How to decide on the boundaries of this region is 
something that can be done based on the value of z, so that we can establish a 
maximum allowable value of z, say zm < ^max, that we are willing to tolerate 
so as to keep the manipulator far enough from singularities. In this regard, the 
area enclosed by the isocontour z = zm will give a nondimensional measure, 
and hence, a measure independent of the scale of the manipulator, of the useful 
workspace region. 

Under no constraints on the link-length ratios, for example, the designer should 
choose the optimum ratios of the isotropic manipulator of Fig. 8. On the other 
hand, when the manipulator is given, and it is desired to control it so as to keep 
it away from singularities, function z can be used again as a measure of the 
distance to singularities: when z attains its global maximum, the manipulator 
finds itself at a rank-two singularity. A rank-one singularity occurs at a local 
maximum. Furthermore, if a manipulator of given link-length ratios — e.g., one 
out of a family of manipulators with identical architectures, but of different 
scales, like the Puma 260, 560, or 760 — is to be used for arc welding, then (a) 
the most suitable dimensions should be chosen according with the dimensions 
of the welding seam, and (b) the seam should be placed with respect to the 
manipulator in such a way that, as the EE traces that seem with the welding 
nozzle at a given angle with the seam, the objective function z must remain 
within a maximum value zm- This means that the seam should lie as close as 
possible to the optimum posture of Fig. 10. Furthermore, note that a rotation 
of the manipulator about the first joint axis, while keeping its other two joints 
locked, does not perturb z, and hence, a set of optimum postures is available. 
This set comprises the circle centered at the center of the first joint, of radius 
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di — the distance of the operation point P to the center of the first joint. This 
circle is similar to the isotropy circle of isotropic manipulators [5], and thus, 
can be termed the conditioning circle. Therefore, a good criterion to properly 
place the seam is that the seam he as close a spossible to the conditioning 
circle. 

Finally, while detecting singularities of nonredundant robots is a rather trivial 
task, detecting those of their redundant counterparts is more involved, and a 
fast estimation of the proximity of a given manipulator posture to singularity 
is always advantageous. This estimation is provided by the objective function 
z proposed in this paper. 



7 Conclusions 

The conditioning length l-p was defined for a given posture of a planar ma- 
nipulator. This concept allows us to normalize the Jacobian matrix so as to 
render it in nondimensional form. We base the definition of the characteris- 
tic length on an objective function z that gives a geometric significance to 
the conditioning length. Moreover, the objective function introduced here is 
defined as a measure of the distance of the normalized — nondimensional — 
Jacobian matrix to an isotropic reference matrix. Isotropic sets of points in 
the plane are defined as well as operations on these sets. The paper is limited 
to planar manipulators, the treatment of spatial manipulators being as yet to 
be reported. 
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Fig. 1. Planar n-revolute manipulator 





(a) (b) 

Fig. 3. (a) Rotation of an isotropic set S and (b) union of S with its rotated image 
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Fig. 4. Trivial isotropic sets for n = 3, • • • , 6 




Fig. 5. Two isotropic manipulator postures stemming from the same isotropic set 
upon a relabelling of its points 
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Fig. 6. Six isotropic postures for the same isotropic set 




Fig. 7. A geometric interpretation of the conditioning length 
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Fig. 8. An isotropic posture with Fig. 9. Objective function of the isotropic manipulator 
01 = 0° 
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Fig. 14. The isocontours closset to isotropy of Fig. 15. The isocontours closest to isotropy of 
the objective function of the isotropic manipu- the objective function of the equilateral manip- 
lator ulator 
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